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m&mm n <z>mx*m Lt=.m* oymmmm. mwnw^mmm & trm-t s mfvm 

mftm<Mt.<n%ixmi,fz.ti*<Dmm&?M. &mmmwmf<z>mm. fc^a^fs 

(Dnm&m^m^\(D^mx\ zamMmmtfrn^tix^z Gma±<DmM.^<b<D 
mm6ma±<Dmmz-Diz, mm.vmm&^mmMz. mm&^&immiz 
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<Dffl$&&mi>mtn<DytMx, *<bmM.mmm%^ftx^z>pi&<£.*>5m<Dmm. 

mmsmvmmz.^**, mmmmw^mmmz. mm&^nimmizmm 

^<D^mma±<DMj<D^m^. &m3iiz&M<Dmm%?M£. m^£\zmmo 
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3 &tcI**<D, *tf 5^(Z>|gjRS:5fc»jRi:bfe, «S;J3.J:tfgB«CD& 
BtJfcffc^oaJSmSflfrat^HftSril^S^SrfiStb, *©mt6«J£U: 

«© 3 «C7cJB6«<©, »fff5o©JE»«:*»«l:bfc, «*;i3 J: 

[0 0 0 1] 
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[0 0 0 2] 

AJimsLzmmLt-m&isx^&t lt&, #iwiii#gL£G p s. (g i o b 

al Positioning System) < ftjflj £ tlT V^ 0 
[0 0 0 3] 

[0 0 0 4] 

jy^c &%.mcD%mmr°te, itfftit, Lif (1575. 4 2m 

Hz) (DC/ A (Clear and Acquisition) a - K£tTO 
[0 0 0 5] 

C/A3- Ktt, Zf\/- h*U. 0 2 3MHz, ^#^R^ 1 0 2 3fflPN 
(Pseudorandom Noise; «^>#2*$tW) ii^G 
6 1 d|?#ICi:»J, 50bps df>yh/#) ODt-*-* ^itL^fCiot 
, MMC# 1 5 7 5. 4 2MH z<D^ U T&B P SK (Binary Pha 
se Shift Keying) l^iltf ^t$> 'J, ®2 0©±SiC^fJ: 
e>tC l&fft^f-^- (PNf#) 1 0 2 3f>y^^l^I (= 1 m?J» £LT, 
^JjglJ- So 
[0 0 0 6] 

[0 0 0 7] 
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2 0m#£l \Zy btLX. 5 0 b p sT'tej&StlS. (1 
m#) 01O2 3'f»;^t tfyhtf "1" <D£g£. "0" <D£i*£.X*te. & 

[0 0 0 8] 

mZftZo 3<^C (6#) tt, 1 0 K (3 0 0 h) T* 

fdian, 1«7-F (6 0 0m») », 3 0 hfy h7?fllJ*StlS. 
[0 0 0 9] 

02 1 tC^1-J:e>{C, Ilty7I/-A^e>^5^7l/-Ai"ecD#U-^7 
l/-A©Hl Ktt, TLM (telemeter) "t7- KfcStU H2 
Flt.HOW (Handover Word) fcStlS. 
[0 0 10] 

'«1 t7- K©TLMt7- Ktt, Hi t?y I>^^8 \£ v h**CtC, tt-*1$3L 

H9lfy K*^H2 2tfy h£7HC, fS9fc> h&MSB, f 2 2 tfy h £ L S 

B£LT> TLM^yt-y««fllAStlS. 
[0011] 

12 17- KCDHOWli, |gl tf>y h^^Hl 7 fcfy h £T*JC, Hi tfy h £M 
SB, fgl7t^yh&LSBi: It, TOW (Time of Week) *9 
> yiZ-^7WA£*U H2 0 \Zy h^e>H2 2tfy b£T'lC, U-77 1/- 
MD (»J=r-K) ^#A§ti5„ 
[0 0 12] 

[0013] 
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[0 0 14] 
[0015]. 

TOW#7> y-fe-^li, (6#) r i: fC# Hfig? 

»^TOW*^> y-fe-Sncfg^lTS^-* B B = A+ IT* 

[0016] 

[0 0 17] 

4 -•9-7*7 I/- 0:^115 •9-7*7 1/- A©2t77 1/-A©i3 7- K«»C 
[0 0 18] 

[0 0 19] 
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[0 0 2 0]' 

<ST?*j^1-^^7 l/-A^5>|g3-9-^7 l^-A*-e©3-9"^7 U-A#0> 1 8# 
[0 0 2 1] 

7 5 0#) ^©f-^^StJSsStdDtft'J, %±©««!I^^e><OlW 
» tc J: o T IS: H ? £ K 3£ff $ ti S ftil'ff^ T* & 5 „ 
[0 0 2 2] 

[0 0 2 3] 

imtlCSfeotlt 02 2tC^<fce>lC, iS^IISi«ra 
flUSti, fffl|ItilCfel^IlSi(DfiI (3^7C^«) &Xi (t 

i ) , iisi towsm^ftstmm 1 ««snfe«ras:s«« 1 ^©^ttTit 
cttsi:, iis i ^e>ffn ^T<z)ggitJco^, son ^s^rs. 

[0 0 2 4] 

fc£U MS i OfifiX i (ti) tt, S(9 2) Tf'aV^J^fc** Ml/ ( 
j£ (9 2) ©^ia^JffOTfcj:'** h;KZ)ig5:St) t'feot, ±fa©x7i^ 
U^«HA>e>#e>*lS »J, SiilCfifiXott; S (9 3) T'^f J: 

^ftKthii & (93) ®*a*i(5TiM^ h^ciiisiit) r 
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[0 0 2 5] 

Utiitms. Lfc^ot, 5£ (9 1) tt, 4^(Z)7fc^JtS:x o, yo, z 

o, T&ttstoi:^^. 

[0 0 2 6] 

-eofcft, S (91) 5£ (91a) ~ Old) T'zk~?&5lZ. 

4>fc<£%, i = 1 ~4tf)4 4H<7>?»miCo£^i£U 3©SS^ (9 1a) 
~ Old) Si<iti:j:ot, tfi«3 7^Sgxo, y o, z o fcUffi 

[0 0 2 7] 

jtSE^s^: oia) ~ Old) mtez>m%a%Lm±a>mnTg.<D&^ 2?k 
b t & ^^-^na w (c Kxm-r 5 * t? ra c tf» s&f « r ^ ic j: 

[0 0 2 8] 

[#s§ m #m& I * e> t -r & mi 

It i fcffil^LT, WsSk S i ©tSX i ( t i ) -ji^gs* Ola) 

~ Old) &#v^, SteaosftTcM&fcffi-raore, gte»©@sm& 

[0 0 2 9] 
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[0 0 3 0] 

& l ©^©M&tm^eST'tt, 

[0 0 3 1] 

HJ©|g^«rlBI i: c&5Rn?* b £ ©«mn#M, »««F#S#Bf Ifl % tH** £ mi 
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®m 3 #C7tJffi« £ W ffi * o 
[0 0 3 2] 

[0 0 3 3] 
[0 0 3 4] 
[0 0 3 5] 
[0 0 3 6] 
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Hilt, £©»iB©WffcJB««ll^l/T<Z>GP SSii©-HIfil:^t „ 

[0 0 3 7] 

m-t&fc&ftmm&frbt&z&mftmmfti 2, *>f ^>^«#^ia»i 3, 
*n^iBiaia&i 4, Msisgpi 5, iffin»is3 0, mmt^v 1 6, 

[0 0 3 8] 
[0 0 3 9] 

, CPU3Uix, -e<z)/U3 2ic, CPU3 1 Wl;i/-f 

>*^©^n^9A^S|J&ia3t-r-**«*^3a*tlfeROM3 3, CPU3 1 
©r7-^xiJ7&ifi:Lti|gtSRAM3 4, *ft»IBia» 1 4 *»&©^n ^ 

3 7, mmMmms s; fcj:tf±ffi©jfiig*^y 1 6«$n§. 

[0 0 4 0] 

MffiM^^u 3 7«, y i:sn, rtuc, «©m»'ff#g"r?&£ 

[0 0 4 1 ] 

M $g # * £ & * n fe *> © r* & £ o 

[0 0 4 2] 

"3tf>f§#&, 50bps©f-*t ff^l/-h^l. 0 2 3MHz, ^ 
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#1 0 2 3®, mMkZ£.iZfcto*>ft&&mWWZ&VX«>? h^2>ifcf!i:Lfcte# 
(C/A3- K) (Ciot, MM^l 5 7 5.4 2MHz©^'V l J75;B P S 

[0 0 4 3] 

:©7>ftllT?SilS*lfel 5 7 5 ; 4 2MHz©fM> 
2.0<Z><£JtW*t?lfilII&2 1 T**flp§£ft, A> K/U7^/H 2 2 T? 

[0 0 4 4] 

&tc., mm&nm&l 2fr<o<Dmm?UV PLL (Phase Loc 

k e d loop) */ynvj'*rtt<DmBammm2 5 Kfcmznx, m$m 
aftfc»»*8fi«^##e>ft, ■e©Mau»fi«^«« v *r^M«miai&2 4ic#fc 

#fr3ftT, Il^?i© 1 5 7 5. 4 2MHZ0W, M&ffigMM:, flf*. 
«1. 0 2 3MHz OD^riMtf #idi$tl5. 
[0 0 4 5] 

T'ifflSft, D-;\°*7^ 2 7T?^«ftff|»3tLfelfe, A/D=2>/1-#2 8 
T% 1 h£fe«2 tf y hJ^±tf>-r£?£;M^ (J£*T> IF?-*£^o)lZ 

[0 0 4 6] 

^©fiffl^Mfflisfts. rfttcioTfBM^iisesft, »j^&©ifcifc«F-3© 
■fiffitffcifisfts. 

[0 0 4 7] 

t>t-> i i ^s^aft*^tctt«k©«M^e>0fi£«c^*^*fts^ 
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mmmmmi bizit^xcDmrnz-D^x^mmw^mM^ti. m^w^^m 
£titz£T<z>mmz'Diz. ±m<nmfflffimtfmfizn. ffiMt^M^tais 

[0 0 4 8] 

mmmmit. mmw^oimfflx&z lmwammftizmfi-zsmx&z. mm 
muiz^^x. h^&mmmtfftiDn. mm^(Dmmmm (tow) & 

[0 0 4 9] 
[0 0 5 0] 

^m^ti^^gtt, 3 8 (c <fc o T, -r-f l^-f l 7±{c, ifiS* 

So 

[0 0 5 1] 

mmmism^mm^m : a 2-~h 1 8 ] 
(mi<Difmz£z>mmm = 12-01 d 
<m 1 ^fes^^M : m 2 & <t t>*m 3 > 

■tfbtm&im^mT*&z>m&iz\z, gmrnvt^v (mi (DmffiMmx&m&m* 
^U3 7) (c, «^!rx^7(D{t:i^J^c^sLTv^feMcDft^t'M, fc^t^f^M 

ftrff H IZ J: o T 3f ffi S tl gfc m V> 3 & 7fijffi«#«# £ *l t v > s „ 
[0 0 5 2] 

[0 0 5 3] 
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[0 0 5 4] 

[0 0 5 5] 

[0 0 5 6] 
[0 0 5 7] 

fit, (1 a) T^^^C itSOMS i CDjfi«fc^#l§#^ 

it i 1 m#5fc§&<D«J(BteT ciil m^lfflWTmi 

[0058]' 

m#J^±tf)tfj<Z)ffiTni i «, BT 2 0 J: #0 2 1 (C^ L V "fe - (flit 

M) {C-^ttlSTOW (Time of Week) 

[0 0 5 9] 
[0 0 6 0] 
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o 

[0 0 6 1 ] 

Z(D&mV&. m2<D& (1 b) V*?£$K, ffiffc^l&felS 
it i © 1 m#«lCDf©|Tmi i$^|Jt o ^^frttf^T i ^cDfnT'St 

[0 0 6 2] 

mmw^mmmmt i a b) t'Stiticiot, tis i &j:t>^§ 

^i cofeS^fm^-tcoMtcSbfe^ra^^M^^^, 02 2{c^L£5£ (9 
1) fC5£ (lb) If^ALfe, S3©S (2) ^^#^£#< ^ 

o 

[0 0 6 3] 

££U 5£ (2) &C&^T* Xi (t i) (3) 7?^-ri:e)fC^Mt i iZ 

33tt£^ms i (D3^fcMM$:^1-^^ (/<? V KO^MOIT teKV Ml/© 
, Xo(« (4) X*B-t£?lZ%mM(D3&KmM$:m~?'<>7 h/l/ 
(^ h;K7)^W©Tl±/<^ MKDifgff c teJt^cMii, trliffi 

[0 0 6 4] 

Z\ZX\ ^ (lb) (2) cfi©M^^raT i It, %i&<D&oiZ. Wi%\T*2bZ>%. 
[0 0 6 5] 

mmn^mmmt i © 1 m#*?i©^©faT c i jra^tf>ft*B 

ICffi^fU 111 (lm#) #<«M#£SHf bT, r £; 
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[0 0 6 6] 

bfctfoT, ^ (2) t o, Sm»«fiP©^ff©^T, fcJ:tf _ 

[0 0 6 7] 

*z:t% r©!§0J!<z>!&i ^fi©ftra^K»©tlt% flit 

«*^#e>tlTv^s^*<fc%5«©|^fi©^^:^!S:«F#€:s#u itff©feffl 

£5S5£LT, S3©^ (2 a) ~ (2 e) z> IC, i = l~5©5i©f 

M&Co#, ^ (2) ©^fjg^&feli'tS. 
[0 0 6 8] 

^(2a)~(2e)li, 5 7C©3!S£#»?g#g^& U , W3lttgflf#e>-1 

T*£, gfi03^1fxo, yo, zo&iffitSiil^tSS. 
[0 0 6 9] 

<m ©#i&lCfcttSjWi&©-M : 04~H7> 
^TfH 5ffl©«5M{C"OV^T©^ (2) , (2 a) ~ (2e) S 

, S*jS©f^*W^iS^»«-a-h>a5JCj:oTj|P<»-&S:^ > r. ^ (2) 

[0 0 7 0] 

H4©a(ll) T^-TJr^J&SjPB^KlfiW*^ (2) 04 
0>5£ ( 1 2) T'^-T^e)^ l&iSIHA f i ^ (13) J: 5 & 

(14) T^ti^^I&^ftS. fe£U 5$ (14) tf©AXol±, 5£ ( 

5*. (1 6) ©.fc^&Wfl^&Sfc-r*. 
[0 0 7 1] 

zzx\ mfevmmzm-t (is-) hh<z>#t?w:, ^ (14) «-i 

iC^^&VNjbV i = 1 ~5©5f@CDmm<D£TJCo£, S (13) 
, ^ (17) *^*Sti*J:-5<fc5 7niK^3tS£*e^#e>JriS. 



1 7 



ffi giE# 2003- 3027455 



#2002—182380 



[0 0 7 2] 

fc£U 5$ (1 7) cptf)F£J:t>*A P&, 5$ (1 8) £J:t>* (1 9) T'^-TJ: 
[0 0 7 3] 

fit, 5* (1 7) ' ©5gtit*@5S;S:«?<ii:tcj:oTAPS:#«), $U£tf)J:e>& 
[0 0 7 4] 

(2 1) © J©M*%HBSIJC*^T'ffc,' S5©^ (2 2) ~ (2 6) ®«fc 
e>&C&£ 0 r 5£ (2 6) rfJtf), 5$ (2 7) T'^tA • Bit. h;i/A£ 

^n;i/B«iu vi (t) H#Mt Kfcwsiems ica 

s&K'*? h;i/^*-r 0 z&mm^z n;i/v i (t) — jkjcjb^£>*itv^ «t 

[0 0 7 5] 

(3 1) T^<fc^Jte*JJB«^e»tfllc 

[0 0 7 6] 

5£(3 1) cp©Xo (0) = Xoa«, «T*S>-5^M#C0«»§^«T-^^o 

z (0) S#«W»©i*tf-©«||TK:BB-rs*JJBIlT»y, «TilfcLTS# 
$ft3P©B£ff#*£<&oTV>&VN£ Lfctf>T% OtfS^t^tS. to ( 
0) tt, ill t i 0 1 m^±0fT©f T m i (=Ti + to) (D 

B?f%M t o a tf S. 
[0 0 7 7] 

J^±tf) 1 EB^MtSttSllC^oT, H40SU.7) ©at&^gsSfcjgV^ A 
P£:£#). EI7(Z)^; (3 3) J: o WftKDM g,&&3fc&T, Mmfflt£l£ U 

[0 0 7 8] 
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Mtf&3&lst=.fr : gfrC>mfelZ-D^XlZ. 07©S (3 5) (3 6) £ 

fell* (3 7) iZ^^oiZ. I AXo |, | AP | tfclt | F | 

[0 0 7 9] 

trnxu^t^tmrn^n^n^izit. u<&L&fr^fe£.%&-tz\£i l z?niz 

[0 0 8 0] 

<M&mmT i ©ir : m s > 

5M®^M{Co^TC0^; (2) , f (2 a) ~ (2e) £ft?<lC&, 

Tfc, ^<Z)T i |fffi;&&tf>-0!J£^t-o 
[0 0 8 l ] 

m2<D^: (i b) vm^tismmw^mmmt i ® i m#*i©f©iT c 

TV*S#fc3ti\ fit, ^tJcf^-^^SMi t itf) 1 m®5fcm<2>ffi<DmteT c i 
<Z>#l?*£*lStf>l:\ ^^-^^T i illicit oii, V^*l% 1 mf$^m<£>ffi 

[0 0 8 2] 

zz\X. 88^ (1 c) XB-t£olz. IIS 1 (i = l).©J«f«3Mf 
l§It 1 (D 1 mfJt^CDffiom* t o £-t£il> f^t^T 1 = 0 {C 

a$#Mt o zmfe-tzt. mm^ (id) x^i-^exc mi^t i n 

MS i (1^2) ©fM^^ff WJ t i (D 1 m#J^_h©^T©M*\ MS 1 

<vmm®-%mmmt 1 <z> 1 m?j>u±(Dr€<Dm (t o) tc^f lt, ^ti^^-rti 

T V ^ § £ * 1" t) <D £ & 3 c 
[0 0 8 3] 

If^ot, fISi (iS=2) (4 1) Xyjk-tM&tfm'hn, m 
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[0 0 8 4], 

^ (4 1) ^?>, i^Ti&^sfcS)i:n iiSi©Itlffl6ii 
Mt itf^ttez,, rcitf^Mtit u*, ^ (4 2) taitiis i 

h^ff$|(£>&«IW£&fr^ 5£ (4 3) T«^-f 5£ (4 3) It, 

flS 1 (CoV^te, ^ (44) X*^ fe^U nt'OMtf 

[0 0 8 5] 

5£ (4 3) &J:t>* (4 4) (4 1) (CftA L TM"f £ ^ (4 5) # 

[0 0 8 6] 

' IMriTi^j:t)f«i#Itott, 1 mWZtKDmbfrt e>&V^tf)£LT 
V^£>T% 5£ (4 5) tf)^H$|?9T i SBHiCm^t-^h, 5£ (4 6) 7?^^ 
fflr^tC, ■tt^ti^mz 0 0 kmriHC 8¥£^o3^C&3„ 
[0 0 8 7] 

^ (4 5) tpox&wc&^mmmmt 1, t n±, «m©3^^jsss:* 

[0 0 8 8] 

-€-L/T, 1 (James Bao-Yen Tsui, "Fund ame 

ntals of Global Positioning System R 
eceivers:A Software Approach", John W 
iley & Sons, Inc. , 2 0 0 0) ^>tf2 (liaMBMil 

fc#Jfcl km^gif, lm»©IH^*J|fcg««CD8EJlttlni*jSEfl:U3ifc.V^ 
[0 0 8 9] 

Lfe^oT, ^ (4 5) *©tt«4W«tell&Mt 1, t ii!)Um#|ftlf^ 
LTt> 5£ (4 5) <0*ja©^l^feJ:tJf^2^©ffi*©%)©tt, 8ggi&C$||fb 
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[0 0 9 0] 

J£Lt©#g?>£, 5£ (4 5) .»Ctt**P«Tf&*lfctfc«F-9-»fl|l**ft 1, ti^ 
91*1 &*> 0)0), ^ftl%, *ft«£lEteT?fc<T*>J:vV£fc#;bfr.5„ 
[0 0 9 1] 

3Z1T*, ^ (4 7) T^-T^fC MS i©J£1R«F#»«^ialt i^fMS 

r fflttf^isfw tuno m#it- ofetts. r © 2 o m# i: e> ^ 
«F#©sfaii»iBi©istcffia'r*. 

[0 0 9 2] 

©S^t £^#)T, jRJC**Offt«C^#»^«pK!lt UUlg) ( 1 0 0 0 m#) 
^B#M£ftA-f ilS l t^fg*$<Z)SE!i6te> l fpfcffl l k 
mei^ftt, IIS i ^^«©agiltt, I#»C±8BCD2 Om»S||lAfcl. 

[0 0 9 3] 

(4 5) ®^ja©mi«^ll2«cD^I:^^sv>c^#T*^>o^i:bT% 
, M*. lkmfcl. 0 2 kmffiftffl 2 k mgg<Z>3£fb{C b*»fce>?\ ^fSSUI 
T*^6. 7 /*5$<8^tCl,frfce>fcV>. Zltlli, ±IH©<fce)(CM^^r^T i tf)Jfcy 

»*WIK#SEflli*J*'T*tt3 o o kmT*feSzii:iii:fc^i-Sh, #f£ic;fo1*;frfcg 

Tf&U, 5$ (4 5) <Z>£j2&0. 1 m#©|fit'0iSAtS r 1 1: i o T+^t 
[0 0 9 4] 

[0 0 9 5] 
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(4 5) t*K3DXo fcLTtt, _tf2i:|Bj*§l<D3SSUC iot, g&£n"£& 
[0 0 9 6] 

if^ot, a (45) icioT. &%tT*$>z>ffiK<DWiMmm&£xf&mme> 

i © 1 m#*?itf)#xtf)>filT c i) 5M©MJCoVAT©M^^raT i £|f 

[0 0 9 7] 

0 0 0 kmH^oW&T'M^T^ZtUfeLr*). %mm& 1 m#tfWc&J 0 . 
[0 0 9 8] 

1 1 > - 

tizmsoyjX; (4 5) {cioT^^p^T i ZOUC^m £ = 

[0 0 9 9] 

W«*k |g|B©ffi«BB«Jc»UT^:S<3Efl;t/Tb*v^ ^ (4 5) tciotf 

matlfeSS^WT i *|»©Jt*«F-9».fl|B*jiff©lli:a«!oTL*"5. 
[0 10 0] 

[0101] 



2 2 
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08©^ (4 5) (DmmKc&mvx* m&zftteifrbm.mK.mm-t&t.. w 

9(D& (5 1) (D£oiZ&Z> a 
[0102] 

M^pflT i j)\ f©ft/J«-efeS 1 m#"f tlSfe&tCW:, 5$ (51) 0>« 
c T i #jft<j3 0 0 kmmtLteVtUX&b-f, MlflT i £. LXJEL\^U^M- 
ffi-r5£aMCte, fcTi^, |g#l#ISIT i OiELV^tCSfr UT, $J±15 0k 
m(Dmm. &mmW.X»ffi±0. 5m#<D|gB&ClK£oTV^#;fttf&£&VN 0 
[0 10 3] 

S (51) i£<Z>Xo t \^X\*&mm<OWt&®M*:ft,A~?Z>(»X'. $.0°, Xo# 
^-fb-r§«-^$:#^.§o Xo^Xo + AX^ffcfSi:, 5£ (5 1) C0^fi2<Z)fg 

lat'tttis i t%mm<nmwit)K m2m.x\rmm.s ih^mm^wmt)K z 

[0104] 

m&Miffi&m&nLx. ^?n&ffiM>£.&mmzm&Mmji\%iz&^x&Mtf 

S i £%mm<D&Mtfffi,'p-t2> : b(D£-t2>tl, ^ (5 1) tt^C (5 2) 
[0 10 5] 

Ml/A, B#\ EI9tf)5£ (6 3) <DM&Zmf~-?£.1*. ^ (6 4) CDBB^^St 
t5„ f bt, S.(52) T'te5£ (6 5) (Dm&tff&±L-tZ>CDX\ KZhJIA, 
B^^C (6 6) (6 7) <£>J:e>}C5g#)££, ^ (64) (6 8) 

So 

[0 10 6] 

^ (5 1) ©£i2©l|l^£J:tm2S^1 s niC£V>T : & TXo 
^Xo+AXj izmthfctUfeVXlb, _Ltt&L££e>&, lgl^T^±£g||^fi 
SDL (^ (6 8) (DtiMCD^JV , ^2^T^iEEH^^f S (^ (6 8) © 
£fl!f£>^5£) ^TWnJfg^&So 
[0 10 7] 
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-£LT, S (52) 2 | AX | ifimi 5 0 km«^, f^^Xo©i 

l&SEHS I AX|^7 5 kmJKWT*Jntf, H#BSMSfT i ^ LTiEL vn#$:#» 

[0 10 8] 

#±au M<2 3^j^mmir£<Dcjf v^^jt i , t utm 

[0109] 

±54 b fe j: e> jc ^sii^. &m m zmsmm^fa k £ n s &mm km* z> 

ti 1 m&^-ftL&V^ 
[0 110] 

m% 08C7)^; (4 7) T*ijkLfr&$K. MSiffllTOM^It i 
<£>> fj£TO#coM^«<DMtc^^-rs 0 «f*^ft««©ffilKttiniUa) 

fSlC 1 mf{ttSfc^t5. 
[0 1 1 1] 

fit, flS Ifei^fiS i©3^7tffif ?:^Sfcfe©^Ii:tT, t 

l+At (££U At^oiits) £/§v\3 fc-rtwi, rfflti+Atti, B 

8(D^; (4 7) #mJ>, 01 0 0^ (5 3) Tf*£ JxSCDT*, 09©^ (51)© 

@io©^ (54) 

[0 112] 

fc£u ^ (54) a, ft%i«^iiT, ffi©lg^b^, li« 
2^©M*^^"ts J: e> tc, m&s i ^cov^T^±S«**^^^y.• iis i 

[0 1 13] 



2 4 
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Z<D7% (5 4) frfc, S (55) T-mZtlZ A d 1 5 0 kmj^^ f&fr 
t»At #$J7 5#^fr-e&4"Ui, ^#B#fl3T i £ LTiELV^£;£#>§r ttfX* 

[0 114] 

URgUi. ®9tf):£ (5 2) (Dmmumi 0(D1& (5 4) 
fe^$:^-r<5>i:, Hll©.^ (5 6) CD*#S:»fe-tt«, (5 6 

) ©&ja<©flE«t^»& 1 5 o kmJKwe*titf, mfrmmr i nLT]EL^mz& 

«)S3i:^T't5. 5£ (5 6) CDMiS* 2T'#J££. ^ (5 7) 
, A t W:£0HBfclMl -5 
[0 115] 

irt', | AX | gf9 -e±xBLfe«fce>lC, Sf«|ffll!f«fi*i:lT^5 

j»*i:**<z>S#*©ffi«i:(Z)BE«n?**. Attt, «fia>JK*«F#aMB 

) tt, ^ (5 7) ©;*-*'-&C#LT+£M^V^T-MllT*££o 
[0 116] 

[0 117] 

<®m> 

itlSTOW (Time of Week) ^^lT^^4^^tlt^ot : fe, 

m^m^mm. fti©«tisfii, fe*tf«B*si(^#bnTv%nji, tow 

Z>Wt%}<DM&$.T*<D}%ffl (TTFF ; Time To First Fix) 
[0 118] 
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mmmmtf&MT'g-f, lmwm&v^tfvttfmbnft^wnizm^xb. m 
^mmomm £ it m & r zitfxzz v>x , m&^cd i«i± & mmi-z z\z.tfx% 

[0 119] 

txomiz. Tow-hmfeznz><&mtf&z><z>izMLx, z<Dmm<z>%n <D^m 
xiz. Tow(DmMzmc.riz%mm<Dmmznm?zz\ttfxg&fr&, &m 

[0120] 

(m2(D^miz £z>mmm •. mi 2) 

i©3/Mgxo, yo, zoCD, &tfSm<D*%amZm-tZ>m3<Dj%; (2) 
Ol'fiM.iZ,*. 03®^ (2a) ~ (2e) T'^bfcJc^lC, i = l~5©5i© 

iot, S»3?^iSxo, yo, zo^iaitStOT'SS. 
[0121] 

, mm'mmtfmt>nx^z>'p&< t^em(Dm&(Dmm^^^mL, mmw^ 

CDfe*B£5£5£LT> 03©^ (2) (DloM^. *(D'pt£< tlb 6f@CD$jM{Co 
M^-^EIl 2(D^; (2 a) ~ (2 f ) Xm-t^OiZi = l~6CD6fICD*M. 

[0122]. 

iSm<V>3i!kKmmx o, y o, z o CD, -£r§f 5lT^'J, ^ (2 a) ~ (2 f ) 

5 fhmmm&ijm&x& y 4fe3sa9Sfiv^ & 1 o^i:©*^^** u 

*l<0*jSi:pr»©*as»CJ:oT, S««0 3*5Bjffi*x o, yo, zo^Iiii 



2 6 
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[0 12 3] 

^(DmZm (m^6) fttHf. g4©^ (17) tpO)K^ h F #\ m=ff^^ 
h/l/fcfey, S (17) fp<Z)*T#IJ#> 05©S (21) <Z><fce>&5*f5#lT*l£ 
m?T5?tJ£l&£ 0 
[0 12 4] 

L^U h^F^fT^'JJO-b-^f X^ott, « (17) ft, 5'#MCD 

[0 12 5] 
[0 12 6] 

^3feO^^(Z)4^MtC e J;^#-^(DBI2 2<Z)5£ (91a) ~ (9 1d) ^ $1© 
*i*©5«J6lCJ:*»#©BI3©^ (2 a) - (2 e) ©J:e>&C, 

[0 12 7] 
[0 12 8] 

(»3©#«feK:J:*Wffiff-J|t : Hi 3) - 
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[0 12 9] 

[0 13 0] 
[0131] 

@3 ££l£01 2<£>5£ (2 a) ~ (2 d) ©j:e>{C, 03fflS (2) tf># 
(7 1) &^ii-r^ 0 

[0 13 2] 

S (71) t£tf)Xo ate, 3 Sfgil M*JMfrffc#<b*i 

£M&^T*&'J, S(7 1) t±, ^I^C«tfM> (jffi«|8Cj&) &C5#g<Z)$J 
Mtf^u -en^^^fsm^-ecoggii I Xo I #i»<Z)gEiit I X o a I fC^U 

[0133] 

gcDtiMtcov^csraf 5^ (71) x-mztizox', eiscd^; (21) © 

nmomsft*, mi 3005$ (72) ~ (7 6) izmgnz-zztizz^x, m 

[0 13 4] 

ms<D^miz iott), Hi ^3i;^2(Z)^^^lil^(D^^#e ) ti^ 0 



2 8 
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[0 13 5] 

(m&Wim&Mmjb-f-y •. m 1 4 ~m 1 8 ) 

^mimmt i tfmfe-t&manzit. @3©s (2) *©i$tit o^m^nm 
-e&&<&3£>-e, ^3Rco^^(Dj:e>ic, %mm<D3&fbmnx o, yo , zo 
£z$%mmftB<Dmt<DmmT ^^mt-t^>m2 2©* o d omnxit 

, *(91a)~(91d) T*^£o\Z'p&< £ 4 ^CDijMlCo U 
?<D&iLj}mj%ZM< Z\ ilCiot, ^fSiltf) 3 i^j^x o , yo, z o 

[0136] 

M&iZit, f©M^M^fIt i«^Lfe3f®0D^M(CO^, ^(91a 

) ~ (9 1c) oiiick (9 1) ©^i^^fit^^tti:, 

j £vO&#&c«£&;it-t\ ±iHl/fel3©*ffiicfeW5Hi 3 0* (7i) £ 

m^<DBI2 2 0* (9 5) &^5iLT,,* (91a) ~ (9 1 c) fcitf (9 5 
) <DMttnjX;ZM<Z£lZj:^X. ffi0 3^7t«xo, yo, z o 

[0137] 

* (9 5) *©Xo alt »-£&£^fM©1M&e, M*l«iu&C#<b*l 
fe«M*TfeU> * (9 5) MlftfCiM^fr (j^Jgdj?) {C4#@tf)*tr 
M##£U Ztlfrib i %mm£T*<D3&M I Xo | #»Jtf>gEgt | Xoa liC^b 

[0 13 8] 

K^tiKDm&mm : 0 1 4 > 

01 4 IC, EIltf>|gM;Jffi<Z>^S$8tf)CPU3 l^TO, !gl~!g3tf)#&;l3 
£ t>*^C0 £ ^ ti'^CWl© JV - ^ y <D -W * B"? . 
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[0139] 
[0 14 0] 

S a, mWtftm&m&fMt i © 1 m# 

*»Oft(5|T c i) «£bT^^il©I^^Sc, ftim#$8fel$M t i 
#fiDrLTV^^Mtf)|fcl=r£S rttSi:, SrCScCSat^S. 
[0141] 

VN-S^MCDifc I S r | 3 J^±"e%&frWfr£tfl9rls, 3#±T*2&*Ui, 
[0 14 2] 

Sflt i t>m%.LT^Z>ffi&<Dm I Sr | #4JK-fcT?*fttf, @2 2©^<i:% 
S (91a) - Old) ©*Si*S^&jWv%T5t««©3^7Bjffi*&l|tfflU 
Jfcft^lSIMMt i 3^flt^LTV^«M©tS[ I Sr |#3T?£>*U*, ®22tf) 
^ (91a) ~ (9 1c) fe<kt? (9 5) ©jtiS^g^;5:«?VNT^«i© 3 #Ctg 

[0 14 3] - 

'&M<Djimz£&mmmmm<Dji-*y 4 3 &nff L^e>, *^->v:/4 4 k 

&i^7U *5^y ^4 4 j^&^-f-y ^4 5 iciitf 

o 

[0144] 

Xf^4 2T, iftitf^Sf^t i #flt£LTV^tSm©» I Sr |#2 
[0 14 5] 

3 0 ffilE#2 0 0 3 - 3 0 2 7 4 5 5 
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MLX^Z>mML<Z>m\ Sc | #5 t&£^*)\£¥rJ!>lTU 5T*&tt*li£> Xf7 
^4 7fCiiA,-C\ J«^F#(Z)^«^bTVN-g)^M^^ I S c | #6J£LhT*& 

[0 14 6] 

fit. mmn^nnmmfe.vT^zffiMLvm i sc i#5-c»&£££ic& 

, X9-y74 6fr<b)l-?-> 5 OlZM/vX. %k.7&(D <fc 5 {C|| 1 (Djj'&iZ J: 
im^^l^T U JM^Ofeffi^Si^LTVNSMcD^: | S c J #6J£U:T* 
$>Z>tgiZ\Z, 7,tv74 7fr£;i/-^> 6 0JC}§A,T% ^M<Z)J: e>{c^2©^ 
&(Cj;3M&Sf3f&3l£l^T U, It 3$JMtf>ifc I Sc 

I #4 T?£££^&cte, *^y^4 5 ^p>;v-^:/ 7 0&CjtA,T% ^co^^fc 

n 3 © # & j: £ m& mnmm mn t- & 0 

[0 14 7] 

;V-f>5 0, 6 0 S {i 7 0 ® Ifilf I^a & I e> , *^y:/4 8fC 

$:H7t, ^#£4x&^o£££JCte, *7^^4 9 blzM/vX. m&£:Ml£ 
lt> .1 ®0M&&S£^T-r£ o 
[0 14 8] 

^f^4 7t, M^omB^^LTV^^m^ I Sc \tf6£i±X 

&^£¥mvfe£.g. ?&t>iDmmw^<D&ffitfmfeLT^z>mML<Dm i sc i 

#3&TT&£^¥!JBiTL£i:£icta, ^4 9 b izm/vX\ m& J kmt.vx 

[0 14 9] 
[0 15 0] 
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[0 15 1] 

r®;i/-f>5 0tlt £1\ ;i/-^->8 0T% ^£>cfce> ic^friMT i © 
fe) k£i£U b)iP*m6<n& (3 1) lzmLt=.®Mm<nMmtLfrm 

. Xf7^5 2iCjtA,T% S5ffl^ (22) ~ (26) Ciot, lelEItf)^ (2 
1 ) OftPiJ 

[0152]. 

#CIC ^^^^5 3 iCjt/uT*, BI3C0^; (2) (rcD^ti, 5£ (2 a) ~ ( 
2 e) ) [CioT, 04^ (17) fp<D^^7 h;i,F 2 ^CX^y^5 

4JC*IA,T% (17) &^TA P$:^§» 
[0153] 

#ac, Tstv? 5 5icjiA,T% 07©^ (3 6) oiRm^^il^t-^^^ 

[0154] 

S (3 6) ©^Km^f4 : 5:^fe$^v^i:^^ctt, Xf^5 5^f,^f^5 6 

*1a,t% *<D4 y ? u * y h%L<nmm k tffflmmmk m a x 

5 4 TJIffi^tlfcA P ^iDxfetj(Z)§:if^^^^ hJl/Pi: IT, ^5 2 (C 

MoT, ^f'V/5 2Ji(T(Z)M$:i'Jlt. 
[0 15 5] 

X-ry^5 7T% M^fmcDMk^SJPSIlI^kma x5:lifci:fl||Lfei: 
[0 15 6] 
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ft- 

[0 15 7] 

<m2<D%m\z£z>mmmmm mi e> 
mi 6tc, f$2o^mz zzmmmmmoK-ry 6 ocD-wzm-t* 

[01 5 8] ' 

m k&i fcu'<<* l*;i/P«:H6 05£ (3 i) c^UfcOTttcoMti: 

, y :/6 2 iCitA,T*, 05©^ (2 2) ~ (2 6) (Cj:oT> ?T n J (^tf) 

I^ll H5©A (2 1) ©J:3&5fi 1 5?iJT*te&<, m^5^'J) £:£#>£o 
[0 15 9] 

#clc, *tv?6 3izm&x, mzotf; (2) ^fc^fc^ ( 

2a) ~ (2f) ) (Ciot, 04©^ (17) tfJtf)^? h;VF (ZK7>^-£&, 
m^r^'h/l/) $ <b ICXf y ^ 6 4 ICj1A,T% 012©^ (61) 

[0 16 0] 

#ac, X5^y^6 5lCitA,7:\ 07©^ (36) (Dl&J&gkftZmf^fr'gfrZ 

pmu mr^-tt^izii.. ^f^e 9 a izm/vx% mmm^jjtvx. w& 

[0161] 

S (36) <D!&M3kftZffife£&^£.£lZl$. Xf>y^6 5A^^f'^6 6 

izm/vx. fr'mm<Dmm\i*it±njy?v*yvi,. ^^k^v^qik 

6£rU @*_TVN&tt;ftkL ;*^y:7°6 8 IzM/vX, W-Mft^Z h JV P icx^ y :/ 
6 4 T^m^tLfeA P £#DX.£ : fo09£$T£&^ N;i/P t bt, X^y :/6 2 tC 
Mot, Xf^6 2gTfflM^l l JIt. 
[0 1 62] 
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So 

[0163] 
[0164] 

<f 3©MtCiSifiItt^a: 01 7> 
[0165] 

r©;i/-f>7 0t'!l if, ;i/-f>8 0T% ^M(Z)J:e>tcM^^r^T i © 

m k& 1 fcU ^ h;bP$rEI6(Z)^: (3 1) Ka*Lfc|gJBH©M»£ l/fcffe 
, T.'rVZfl 2 {CjtA,T% .H 5tf>5£ (2 2) ~ (2 6) feJ:t>*Hl 3(Z)j£ (7 2 

) ~ (7 6) suot, fr^jj (i©»-^i±, i5©s; (2D (Dmmmsft 

tmiSViS; (7 2) ~ (7 6) T*mg&Z.fc 5fr5^|©^rj) £;£#>3 0 
[0 16 6] 

#UC, 7 3 KSiA,.^, 03©^ (2) (£0>©-£fcJ:, S(2a)~( 

2d) ) fe<fcrf01 3tf>:£ (7 1) [Ciot, 04®^ (17) cfKZ)^^ h ;i/ F 
&3£#>> $ klC^-ry^" 7 4 izm/vX% S (17) l:j|?VNTAP$:^S 0 
[0 16 7] 

mz, 5^c5i^T^ 07005*; (3 6) ©M^fc^fei-a^^fc 

[0168] 

5£ (3 6) <&JK3ft&#&iftfc3fcv^#icfc}:, ^vzfi ^-frh^vzri 6 
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•y 

twu M^-^&tttui, 8iC3i^T% etff©^^ h^ptcx^y ^ 

7 4 T*3fm$*l£A P fc^A.^©^^^ b)VP £ IT, 2 }C 
MoT, ^^^^7 2^T^>ra$:^^igt- 0 

[0169] 

[0 17 0] 
[0171] 

<HfM*WT i ©irm&a : 1 8 > 

1 

018 tC, 015, 016, Ml 7 0)l-^y 5 0, 6 0, 7 0 t£tf>, M#B§ 
181 T i ®IM©;i/-f> 8 0 (D— Bf&as-T. 
[0 17 2] 

©HI t o a 7?OflS 1 ©ftf X 1 #ac, ^f>y^8 2t% ±iUfc 

J:e»{CT 1 = 0 tit, IIS 1 (COVMTCTX S8©^ (4 5) (DttJKDm 1 ^ 
iCffi^Sftd 1 £:£#)3„ 
[0 17 3] 

4 lCjtA/T% ±fB<£>t$M t o a T'©I1S i fflfifX i £ o IC X ^ y 

8 5&C}iA,T% ®8tf):& (4 5) T*$tl-5, IIS i VMT CD^#B#HgT i 
£ Jf ffi "3" -5> o 

[0 17 4] 
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# i & 1 £tt>f>* U h Lfc_tT% Xf'^8 4iClot, ^fyy8 4fit 
[0 17 5] 

^CPUjSJ:^!^ ^vAiC<fcoTMftftfl£?Te>«llrT*&£;^ GPS 
[0 17 6] 

, sif tissg*^ ^ © <fc e> feints* 1 1 1 s Mmmmmmmi 

[0 17 7] 
[0 17 8] 



3 6 
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o 

[0 17 9] 

mmn&mmmi o otit gps %mm 9 o^^©*^?M©if^ 
t>t^ 1 0 1 X'%m s.*i, 1 0 2 t'M^isti, ^tra 1 0 3 

•e«i»StiT, ±SE© I F^-^jWbti, 3 1 0 4 rt®Hftjf 
[0 18 0] 

j:otfte»tit, ^astnnt^a^ig i o o <D$mmum 1 o sictt^jntifi 

[0181] 

m&*sjh<z>&s, tfett, ^ff«n«£3iss i o o <DnmmffiT-m&. «n^e> 

■ 0©ffi*#iBv>e>*i«6. ^#<z>t§-£, ^PSfMlgSi o o#gp ss^«g 

[0 18 2] 

o i^e>GP s&mwiQ oi,zmm^n^ 0 

[0183] 

GPS§fi9 0tH 7>7^9 ltSHSft, &£teSP9 2 

$e>ic, ^o&SfiNglcj: y, fflffr9mas3 oicioT, f^^u^fi 7±i: 



3 7 
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, MMftV l 6^^»*fflS4^feaiBIfl^R^cJ:oT^S^^fc«IB^J:^cfev^T 
, GPSSij|9'0Offitt^S*l'5.' ' 
[0 18 4] 

GP SS§«9 0 i:LTI±JfiH1f«S:fipfef t, MSIMSfilO 
*&IC, *iS«£«3I&1E 1 0 OfrfeGP S3«fft9 OC&MStU G PS§|| 
[0 18 5] 

3<Z>jyfc^<Z>M&^X^ACJ:*W£, ^MWgSlOOT'il TOW 
£f«££-fr3^&<> ±^Lfe*l~»3©t&SsK:J:oTS««l©**'felltm 
"TS^il*«Tf$S©7? v G PS^ti9 0 21 Ltli, TOW&fltJ£3-£S©lC4& 
m&6®ft&>_t£^o £ote&m$ft<DI Ff-^MilMifilO OtC 

- 3? & ftttf 6 ic^SI* ;* =e U « & **glc 893*1: 5 r £ £ £ £ i: JC 

[0 18 6] 
[0 18 7] 

±34LfcJ:^JC, r©»W»c-J:ti«, £#«0>jgimt&© J: e> CSff^MJ'* 

& ti t v * ft v ^ik> , <b <z>m# & « » \zmm.v>Wk 
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&° 

[0 18 8] 

[01] 

[0 2] 
[04] 
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CH2] 



LnJlJ X i (t i ) : ffi{B(3'&5c&«i) 
S i 



t r : imm&mmm 

t : ftttaHS 



1 sm 



t i 


= T c i + Tm i • • 




t i 






T c 






Tm 


i : 1 m*fr£l±.©*ifflte 





t i=Tc i+Ti+to 


•••(1b) 


t i : ftfkftJH&mSI 




T c i : 1 m»5fe»CD«T(D|l(a:tfc»-9©(4#i) 




(T i + t o) : 1 m|3>ja±CDtiT©tt 




t o : £**K*ij(&1ti£K:KiI) 




T i : Sg-ftM 
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CH3] 



fi(Xo f t, to) = |Xi(ti)-Xo|-c{(tr-ti)+ t} 




= ! X i(Tci + T i+to)-Xo| 




— c{tr — (Tci + T i + to)+ t} = 0 






• • • (2) 


Xi(ti) = (xi(ti) yi(ti) zi(ti)) T 




Xo= (xo yo zo) ^ 





f 1 (Xo. 




to) 


= 1X1 (Tc1 +T 1 +to)-Xo| 
-c{tr-(Tc1 + T 1 +to) + -r} = 






f 2(Xo, 


T, 


to) 


= |X2(Tc2+T2+to)-Xo| 
-c{tr-(Tc2 + T 2 + to)+ t} = 






f 3(Xo, 


T, 


to) 


= | X3 (Tc3 +T 3+to)-Xo| 
-c{tr-(Tc3 + T 3 + to) + t } = 






f4(Xo. 


T, 


to) 


= |X4(Tc4 + T 4+to)-Xo| 
-c{tr-(Tc4 + T 4+to) + -r} = 






f 5(Xo. 


T, 


to) 


= |X5(Tc5+T 5+to)-Xo| 
-c{tr-(Tc5 + T 5 + to)4- t} = 
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[04] 



(Xo(n). T(n), to(n)) 



01) 



A f i = — — A XO+ — — Ayo+ — — Azo 



5xo(n) 
3t(n) 



A T + 



dyo(n) 
afi 
dto(n) 



dzo(n) 



A to 



(12) 



fi(Xo(n), T(n), to(n)) + Afi = 0 



(13) 



(AXo, At, Ato) 



AXo = (Axo Ayo Azo) 



(14) 
(15) 



dxo(n) 3xo 



xo=xo(n) 



(16) 



F(Xo(n). T(n), to(n)) + A F 

= F (Xo(n). t (n), to(n)) + J (Xo(n), t (n), to(n)) A P 
= 0 (17) 



F=(f1 f2 f3 f4 f5) T 

AP = (Axo Ayo Azo At Ato) T 



(18) 
(19) 
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J(Xo(n), T(n), to(n)) = 



r a f 1 


a f 1 


df 1 


a f 1 


af 1 *i 


3xo(n) 


9yo(n) 


3zo(n) 


3T(n) 


ato(n) 


9 f 2 


3 f 2 


df 2 


a f 2 


a f 2 


3xo(n) 


dyo(n) 


5zo(n) 


a-r(n) 


ato(n) 


a f 3 


5 f 3 


a f 3 


a f 3 


a f 3 


5xo(n) 


dyo(n) 


dzo(n) 


aT(n) 


ato(n) 


3f 4 


5 f 4 


a f 4 


a f 4 


a f 4 


3xo(n) 


dyo(n) 


azo(n) 


3T(n) 


a to(n) 


9 f 5 


3 f 5 


a f 5 


a f 5 


a f 5 


L 3xo(n) 


9yo(n) 


dzo(n) 


a-r(n) 


dto(n) J 



(21) 



af i 



xi(Tci + T i + to(n)) — xo(n) 



axo(n) 


|Xi(Tci + T i + to(n)) 


-Xo(n)| 


a f i 


yi(Tci + T i + to(n)) 


— yo(n) 


ayo(n) 


|Xi(Tci + T i+to(n)) 


-Xo(n)| 


a f i 


zi(Tci + T i + to(n)) 


-zo(n) 


azo(n) 


|'XiCTci + T i +to(n)) 


-Xo(n)| 


a f i 






3T(n) 


= — c 




a f i 


(Xi(Tci + Ti+to(n))- 


Xo(n)) • ' 


a Togo- 


|Xi (Tci + T i + to(n)) 



A • B=(Xi(Tci + Ti+to(n))-Xo(n).) • V i (Tci + T i + to(n)) 



(22) 
(23) 
(24) 
(25) 

(26) 
(27) 
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[06] 



(Xo(0), t(0), to(0)) = (Xoa. 0, toa) (31) 

Xo(0) = Xoa : gm&^WSftg 

t (o) : Rmmftunmitamm-r imtztomm 
to(o)=toa : mmmmtoizMTztnmm. 



[07] 









(Xo(n+1), T(n+1), 


to(n+ 1 )) 




= (Xo(n) + AXo, t 


(n) + A t, to(n) + A to) 








• -(33) 



&m¥iJ5£SM*(£ 




I AXol < £ 




I A P | < e 




|F(Xo(n). x(n), to(n))| <6 


(37) 
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[®8] 



t1 = Tc1 +to ..... Oc) 

ti = Tci + Ti+to (i£2) (Id) 

Ti = (Ti+to)-to=(ti-Tci)-(t1 -Tc1) (41) 

c(tr-ti) = |Xi(ti)-Xo| (42) 

♦ • ♦ |Xi(ti)-Xo| /Ja . 

ti=tr (43) 

c 



t1 _ tr IX1(t1)-Xol 

c 

T ,,( IX1(tn-Xo| +TQl ^ |XI(tl)-Xo| + ^ 



(45) 

cx i. 0 x 1 0~ 3 (m) ~ 3. Ox 1 0 5 (m) .....(46) 
ti=t1 — 2. 0x1 Q- 2 m» ..... (47) 
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[0 9.1 



cTi=(|X 1 (t1 )-Xo|+cTc1 ) 

-ClXi(ti)-Xo|+cTci) (51) 



(1X1 (t1 )-(Xo+AX)|+cTc1 ) 

-(|Xi(ti)-(Xo+AX)|+cTci) 

= (IX1 (t1)-Xo| + |AX|+cTc1) 

-(IXi(ti)-Xol-l AX|+cTci) 

= (1X1 (t1 )-Xo|+cTc1 ) 

-(|Xi(ti)-Xo|+cTci)+2l AX| 



=cTi + 2l AX| ..... (52) 
I AX I : &mmaimtil.Wi:LT*x.Zim£ 

I A ! > | B | ... • .(63) 

IAI-IBI £ |A-B| £ IAI + IBI ..... ( 6 4) 

|Xi(ti)-(Xo+AX)| 

= |(Xi(ti)-Xo)-AX| .....(65) 

A = Xi(ti)-Xo (66) 

B = AX ... . -(67) 

|Xi(ti)-Xo|-| AX| 

£|(Xi(ti)-Xo)- AXI 

£|Xi(ti)-Xo| + | AX| (68) 
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[01 0] 



t1 +At = ti + At+2. Ox 1 0~ 2 [fp} .....(53) 

(1X1 (t1 +At)-Xo|+cTc1 ) 

-(|Xi(t1 +At)-Xo|+cTci) 
= (|X 1 (t1 +A t )-Xo|+cTc1 ) 

-(|Xi(ti+At+2. Ox 1 0" 2 )-Xo|+cTci) 
= (1X1 (t1)-Xo| + Atx 1. 0X1 0 3 +cTc1) 

-(|Xi(ti)-Xo|-(At+2. Ox 1 0~ 2 )x 1 . 0 x 1 0 3 +cTci) 



= (1X1 (t1 )-Xo|+cTc1 )-(|Xi(ti)-Xo|+cTci) 

+ (2 At+2. 0 x 1 0~ 2 )x 1 . 0 x 1 O 3 
= cT i+(2 At+2. 0 x 1 0~ 2 )x 1 . 0 x 1 O 3 ..... (54) 

Ad=(2At+2. 0x1 0" 2 )X1. 0x1 0 3 (m) 

~2 Atx 1 . 0 x 1 0 3 (m) •••••(55) 

mil] 

2 I A X I + 2 I Atl.x 1 . 0 x.1 0 3 < 1.5X1 O 5 (56) 

IAXI+1. Ox 1 0 3 x|At|<7. 5x 1 O 4 (57) 
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f 1 (Xo. T,to) 
f 2(Xo, t, to) 
f 3(Xo, t, to) 
f 4(Xo, t, to) 
f 5(Xo. t, to) 
f 6(Xo, t. to) 



= |X 1 (Tc1 +T 1 + to)-Xo| 
-c{tr-(Tc1 +T 1 +to)+T} 

= |X 2(Tc2 + T 2+to)-Xo| 
-c{tr-(Tc2 + T2+to)-(-T} 

= |X 3(Tc3 + T 3+to)-Xo| 
-c{tr-(Tc3 + T 3 + to) + t} 

= |X 4(Tc4 + T 4+to)-Xo| 
-c{tr-(Tc4 + T 4 + to) + t} 

= !X 5(Tc5 + T 5+to)-Xo| 
-c{tr-(Tc5 + T 5 + to) + t} 

= !X 6(Tc6+T 6+to)-Xo| 
-c{tr-(Tc6 + T 6 + to) + t} 



AP = (J T J T (-F) 



0 (2a) 

0 (2b) 

0 (2c) 

0 ..... (2d) 

0 (2e) 

0 (2f) 

(61) 



[013] 



m 3 <DJ5%; 

f 5(Xo) = |Xo|-|Xoa I 
Xoa : &mM<DMV%GLW 

df 5 xo(n) 
axo(n) ~ "| Xo(n)| 

3f5 yo(n) 
3yo(n) |Xo(n)| 

5f5 zo(n) 



dzo(n) 

di 5 

9 T(n) 

di 5 

dto(n) 



|Xo(n)| 
= 0 

= 0 



• • • (71) 

. • • (72) 

• • • (73) 

• • . (74) 

• • . (75) 

• • • (76) 
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4 0 * - * y c^ttoaufittos) 



( ■ » ) 



4 1 



v r 



4 9a 





S a : g{I*<DffiM<D%£ 
S c : H£EM3-^<D{&te(Tci)A< 

S r : 4£fm-^3g(al«(ti)A< 
S r <=S cc=S a 



7 0 



2v 




5 0 



2\_ 



an edicts 
aiifitttff^a 



6 o 



A. 



aijiittjma 



■4 6 






•4 9 b 



ZD — 



c 



3 



1 1 
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[Ml 5] 



5 o >\>-*y<&\ ©:&&ic«fc*aj{&ft3M!yffi) 



8 0 



Ti*J±iM31 



5 1 



k = 1 

P = (Xoa, 0, toa) T 



5 2 



5t(22)~(26)IC«fcoT 
?t5»IJ(P)***5>5 



W £ 



5 3 



SC(2)lc«fc-?T 



5 4 



- F(P)= J(P)A p 




Y -5 9 a 



C 




1 2 
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6 0 J\,-*>(m2<Dl,mc£Zm6LftWim) 



( ■ » ) 



v r 



8 o 



t mta&m. 



6 1 



k = 1 

P=(Xoa. 0, toa) T 



6 2 



5t(22)~(26)fcJ;-3T 



6 3 



F(P)£3Rto-5 



^6 4 



5*(61X 
A P=( 



AP=(J(P) T J(P))" 1 J(P) T (-F(P)) 




6 6 



k = k + 1 




N -6 8 



P=P+AP 
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k = 1 
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^(72)~(76)(cj:-gT 



5S(2)(71)IC«k-3T 
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[01 8] 



8 0 ^-5F>086»P*MT i flOgm&S) 



C g » ) 



X 1 (toa) 



8 2 



T 1 = 0 

d1= JX1(toa)-Xoa| +Tc1 



8 3 



- 2 



8 4 



Xi(toa) 5 



8 5 



_. |Xi(toa)-Xoa| , _ . 
T i =d i - + Tci 
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TV 



^9 0 GP SSffltlS- 
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>1tJISS 
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1 0 1 
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[02 1] 
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[02 2] 



n-F\fl t i : tfM#&&mmm 

UyU X i ( t i ) : M(3*5cl£«) 
S i 

^ s \ c : m^cotftm 



t r : ttifmn&mftm 

X o : (4g( 3 >fc5cM«S) 



X 



1 



IX iCtO — Xol -c{(tr-ti)+ t}= 0 




. Xi(ti) = (xi(ti) yi(ti) zi(ti)) T 




Xo= (xo yo zo) ^ 





1X1 (t1 )- 


-Xo| 


-c{(tr 


-t1)+x} = 


= 0 


• • • • (91a) 


|X2(t2)- 


-Xo| ■ 


-c{(tr 


-t2)+T} = 


= 0 


• • • ? (91b) 


|X3(t3)- 


-Xo| • 


-c{(tr 


-t3)+T}= 






lX4(t4)- 


-Xo| - 


-c{(tr 


-t4)+ t} = 







f4(Xo) = |Xo|-|Xoa| = 0 




Xoa : &mm(DMmiLW. 
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